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1. Abstract 
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a nonUnear extension of model reference adaptive 


control (MRAC) techrtTque/to guide a double arm nonl inearizable robot 
manipulator with flexible links, driven by actuators collocated with 
joints subject to uncertain payload and inertia. The objective is to 
track a given simple linear and rigid but compatible dynamical model 
in real, possibly stipulated time and within stipulated degree of 
accuracy of convergence while avoiding collision of the arras. The 
objective is attained by a specified signal adaptive feedback controller 
and by adaptive laws, beth given in closed form. A case of 4 DOF 
manipulator illustrates the technique. 


2. Introduction 

The MRAC technique becomes popular proposition for guidance of recent robot manipulators, with demand for 
precision pointing in difficult conditions, under the action of full scale dynamic forces, and subject to 
uncertainty in parameters. Such manipulators, particularly these used on spacecraft are highly nonlinear and 
nonl incarirable structures (geometric nonlinearity of clastic links, large angle articulation, nonlinear coupling 
of DOF * s , nonignorable gyro and Coriolis forces, several equilibria), while classical MRAC is linear and 
applicable to rigid bodies only. Thus the extension is needed for handling nonl inearity, see [1], and flexible 
links, see (2). On the other hand many robotic objectives, atfain particularly these in difficult space conditions 
require at least two arm systems. Thus the tracking has to' be a double MRAC (mutual reference adaptive control) 
which secures tracking the same model by two arms while ^voiding mutual collision - cf. (3J, [4]. If adaptive 
(self-organizing) control is intended, the tracking relates not to a given path but to a given dynamic target- 
model with prescribed target-parameters. We take the model simple thus rigid and linear, but locally compatible 
with the nonlinear arms regarding equilibria. Each arm is represented as an open chain with n DOF, nonlinear 
characteristics and coupling, elastic links, driven by actuators collocated with joints, under uncertain inertia 
parameters and uncertain payload. The tracking is done in real possibly stipulated time by a designed signal 
adaptive feedback controller and integrablc adaptive laws in che state space, while avoiding collision between 
arms of all the joints (and elastic nodes) in Cartesian configuration space. 


3. Motion Equations 

Lagrange motion equations give the rigid dynamics of the arms in the general format 

j a 1.2 


A J [q J ,s J )q J 


r J (q J ,q J ,\ J ) 


n J (q J .A'* ,s J ) 


B J Cq J ,qV 


( 1 ) 


where 


q J (0 


q o 

j-th arm varying in the known bounded work region 


is the configuration vector of the joint variables q-J 


□ J of the 


of the configuration space R ; q(t) is the correspond- 


ing vector of joint velocities in the specified bounded subset 
u J (t) k U *■: R n are the control vectors in given compact set of constraints 
are the vectors of adjustable system parameters in bounded bands of values A 


iV of the space tangent to 
U ; \ j (t) e A 


and 


s J (t) c S c R k 


i. S 2n 
is an 


uncertainty parameter within the known band S . Moreover A**(q^,s^) arc the inertia n x n matrices obtained in 

the known way from the quadratic form of kinetic energy. The vectors 11^ = (Tl^ , . . . represent potential 

: : : T in 

. ,(*') represent the internal nonpotential acting forces (Coriolis, 


forces (gravity, spring) while =* (T 

gyro, centrifugal, damping structural or viscous, etc.) and B J is the actuator transmission (gear) nonsingular 
n*n matrix. The control vectors u J (t) arc selected for the objectives of tracking and avoidance by adaptive 

feedback control programs (t) 


i I 7 .1 .7 i 2 

p (o (t),q fc (t),q (t),q (t),\ (t),\ (t)) on corresponding products of 


A^ * A^ * A . For convenience the superscripts "j" will be dropped until they are needed to avoid ambiguity. 

Considering the links elastic we introduce the deformation coordinates for the i-th link as shown in Fig. I, 
while using the Ritz-Kantorovitch scries ;xpansion 


z , 
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r i (y i ,tJ “ ^ r i^V r i* t) * r i ty i Jr i Ct} 

and for , w^y^t) analogously, with the exact solution expected for m 


• • . We take ■ large 


S I * length 

Figure 1. Flexible link 

enough so that the Kantorovitch linearization is physically justified. The technical way about it is to 
stepwise subdividing the links between grid as long as the difference of results for successive m's becomes small. 

Having specified (2) we form the vector nCt) • (n^t) , . . . ,n n (t) ) T , where r* i (t) » (r^t) ,v i (t) ,w. (t) ) T and 

following (5) write the hybrid system as 

A Alfql (0 D.lfql fOPjfq) fr(q,q) fri(q,\,s)) fBCq.qj' 

T L ♦ | C . * I W ♦ . ♦ - U (3) 

A‘Aj^ij (o d |nj |o p j -nj ir n (n,n)J l^Cn.s) J o ; 

where A^n,*) , r^n.n) * CH # s) are the elastic correspondents of A, F, II while A c (q,n) , 

D c (M#q»n,n) , P c Cq.n) and the internal damping D(q,q,n,n) as well as the hybrid restoring coefficients 

P(q # n) are matrices coupling the elastic and joint coordinates. These matrices are formed by integrals over 
the shape functions, see [5], Letting 

A A 1 

A(q,n,s) * - 

i*c V 

to be the hybrid inertia matrix which is nonsingular positive definite, we inertially decouple (3): 

(q/i) r ♦ Vi q,q,n,n,\,S) ♦ P(q f n,\,s) * 6(q,q,s)u (4) 

A . I . . T a - 1 T 

where V * A (D^r^r.Dn+r^) and P * A (P^r;^II are successively vectors of nonpotential and potential 
forces and the meaning of the matrix 8 is obvious. The vectors q, q, n, n form the state vector 
xct) * (x 1 (t),...,x N (tj) T » CqttJ ,nCtJ,qtt),n(.tJ) T ' A q * A f) * * A- • A ■- R N , N » 4n , for each am. For 

convenience (4) may be then written in the general state form 

x » f(x,u,A,s) 15) 

with f » (f l# ... ,f N ) of the shape specified by (4) in an obvious way. Formally (5) may be written in the 
contingent form: 

X < { f (x ,u , V,s) I s < S'- s 3) 1 

which for suitable f(*)» p(*)» U*) has solutions x(t) * k(x°,t) , t J 0 , absolutely continuous curves 

through each x° * x(0) in A . We shall consider the class of such solutions K(x°) by exhausting all values 
of s(t) in (5) at each t . 

4. The Reference Model 


We let the given Cartesian "world" coordinates representation of the reference model in general terms 

* F 

ra m 

3 7 n 

with 2n DOF, £(t) t R , and J suitable matrix, be off-line recalculated to the joint coordinate 

format of the rigid linear system 

ii ♦ D O ) u ♦ P ( a ) q si) 
m m m /M m m v nr^ra 


with the 2n-vectors q , q of joint coordinates and velocities, state x (t) - (qit),q (t)) * \ 

mi ra m m 


246 




£ 

V , P suitable matrices, while A • (A , . . . ,A ) • const c A c ft , * ■ n . Moreover 

mm m mx mx. 


P.(0(q*,n # ) - o 


( 8 ) 


with (q-V) denoting the equilibria of (3) on the surface q • 0. n • 0 . The total energy of the model 

will be denoted by E (£ ,£ ) in the world coordinates and E (a ,4 ) in the joint coordinates, obviously equal 

a m m m ■ a 

to one another. Then 


+ ( p » ( v do 


( 9 ) 




and substituting (7) f 


E .<vV • -ww 


( 10 ) 


The model is selected such as to allow achieving of a stipulated target behavior in the state space. To focus 
attention on something specific and yet general enough, let it be stability of the origin, guaranteed by the 
nonaccuramulation of the total energy i.e, non-negative damping 


while 


VvV s 0 • v s, ' 0 
> 0 


an 


( 12 ) 


in-the-largc i.e. on same CA L * A - A^ , where A L is the set in R enclosing all the equilibria. 
5. Objectives 


Now we consider both arms j - 1,2 and the model together. The block scheme of the system is shown in 
Fig. 2. 



Figure 2. Block scheme of the system 

Define two product 2N-vectors X^(t) = (x J (t) ,x m ( t) )*** * A * A * A" and two i-vectors <v*(t) 3 A^(t) - , 

which vary in A 2 *A generating the product trajectories (X^(X^°,t) f r* (cr*°, t) ) , t 2 0, X^° = X^CO) , 
a J0 = ot J (0) . Then we define the ’’diagonal” sets 


M J * {(X-\r*) < A 2 *A | x** * x m , * 0) , j 3 1,2 , 

and given stipulated u** > 0 f their neighbourhoods 

M ; = uxvrj *■ A-*A | ’• ^ * 1' * J i < ^ ' • > a 2 * 

Moreover we let A be a desired subset of A where we want the tracking to occur, and let t be the 
o L 


2U7 










stipulated time after which the tracking is attained with accuracy 


V 


J 


first Objective: The manipulator arms (1) are mutually p-tracking the target (7) on A q if there is a pair of 

controllers p^(*) # j - 1,2 such that for each solution k^(x^°,t) , t 2 0 of (4) in K(x^°) , the set 
A^ x A is positively invariant: (X^°,a^°) < A^ a A "*(X^ (t) ,a^ (t) ) c A^ * A and given t c> for each 
k**(*) c k(xJ°) the product trajectories satisfy 

(X J (t),a j (t)) < Mj . Vt 2 t c . (13) 



Figure 3. Convergence of product trajectories 
Suppose the transformation from joint to world coordinates (forward kinematics) is given by 

C;* * r 4(q J .n J ) . c - 1 . ,3*2n (14) 

anil denote Z(t) 4 (x*(t) ,x*(t)) . Then we let the set 

A » (Z .. A J | KJ-^| i d, VO.o • 1 3-2n) 

be the collision set between arms to be avoided. We define C A * - A , specified by > d , and let 

A a - (Z .. A 1 I d < < L) 

be the "slow down" safety zone, with e > 0 suitable constant. 

Second Objective: The tracking arms (1) avoid collision iff there is A^ such that for i:ny Z° CA „ and 

any pair k^C*) e K-^x^ 0 ) the corresponding product trajectory 

Z(Z°,t) » CA , vt » 0. (15) 


6. Sufficient Conditions 

We return now to the first objective and specify by N(j(A 2 *A)] a neighborhood of the boundary HA**A) 
of the region A**A . Then let = [.)(A**Aj 11 A q <a 1 , CM^ » (A 2 *A) - and introdi-ce open D J CM J 
such that n * 6 . Further we consider four C l -functions C ' j - N * R , V^( ■) : • R , j * 1 ,2 

with the positive constants 

v{ * vJ(X J ,a j ) , (X-'.a-’) - ) 

s 3 I 

inf V^(X J . ) | (X J ,i J ) . W n CM^ \ i 1 

v^« sup V J ^(X\J) | (X-\.i J ) . t(A**A) i CM^ j 

The first relation obviously requires forming Vg(-) from suitable >(A o *A) taken as its level, or conversely, 
forming }A , iA from levels of suitable V s C * ) ^ • in the latter case a° A , A smaller than these desired will 
be the secure choice. 5 ° 

THEOREM 1: Objective 1 is attained if, given A , A, u there arc prog-aras ( * ) and functions 

v q(‘) » V J f) such that for all ^ A 2 * A , 

a U 


2US 




(1) vJ(X j .a J ) S , V(X J .a J ) < « t , j • 1,2 


(ii) for each u* « p^X’.X*) ; 


v£(X J (t),a j (t)) < 0 , Vs J < S 

along the product trajectories (X^(X^°,t)a-*(a^°,t)) , t 2 0 , j ■ 1,2 ; 

(ill) 0 < V^(X J ,a j ) S vJ* , V(X J ,a J ) « Oi^ , j - 1,2 ; 

(iv) V^(X J ,a j ) S vj\ V(X J ,a J ) < P j " , j . 1,2 ; 

(v) for each ■ p^CX^.X*) there is a constant c^ > 0 such that 

*J(X j Ct),a j (t)) S -Cj , Vs J « S 

along the product trajectories (X^(X^°,t) ,<2(a^°,t)) , t 2 0 , j ■ 1,2 . 
Remark 1: The Objective l holds after a stipulated ® if Theorem 1 is satisfied with selected by 

J 4 

A % 

Cj • — • J ■ l ,2 . 


Theorem 2: Objective 2 is attained if Theorem 1 holds and given d there is a C -function ^ ■* R 


such that for the tracking pair p J («) , for all Z ' CA 
(vi) V a ( 2) > V A (t) , Vz < JA ; 
(vii) for each u** « p^(Z) , 


V A (2(2 w f t)) 2 0, Z < A a , Vs J ' 
along product trajectories 2(2°, t) , t £ 0 . 

^ . / V «*0 1 . A a ^ n 


lX J ,-i J ) <• CM^ , 


PROOF. Suppose sonc 1(2°, tj , t - 0 , Z° « A, crosses 3A at t. » 0 . Then by (vi) , V,(Z(t.}) < V.( 2'*) 

which contradicts (vii). / * 

7. Controllers and Adaptive Laws 

Let us set up 

vi * K (X J ) ♦ E (x ) ♦ aV ; 

o id ni n 

vJ Ajiy ,j j ■ W* aj * J - °i • 

u la J i J , lX J ,,i J ) . M J y ; 

V A * iit.lVj-E/x*) i 

where a- 1 • (.sign i{,...,sign . j * 1,2 . and E (x -1 ) is E (■) with x exchanged for x^ . Choosing 

in a m m 

N in CAj , the character of ^ m (’) specified additionally by (12), satisfies (i) f (iii) and (iv). 

j j • i 

To see that (vi) holds, observe that B (x J ) » t (\ ) of (6) and that increasing the distance 

mm 

iC v -^, x 0 for at least one J from its jA value increases the value of V A . 

To check upon conditions (ii), (v) , (vii) we differentiate (21) - (23) with respect to time 


t. ,tx j ) ♦ 6 fx ) 
m mm 

♦ 

• 

(24) 

i U J ) - E lx J 

m am 

• a^.r* 

, (X J ,.i J ) < cV , 

u 


lEUJ ‘ E.(* J ) 

ram ■ 

♦ aj; j 

. ix j , 1 J ) • cV , 

(25) 

a-*i J , (X J ,v*) . 

M j ; 

y 



IE n l x< )-E.( xl Jl' 


-v xJ >' • 

(26) 


h n (x j ) * VE jn (X J )*f J (T J ,u J , * (Su-P-P^q^) (q,;) . 
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The brackets of the functions 8, V , P dropped for clarity. Moreover CTMjJ are subsets of Qtjj defined by 

cV: E b U J ) 2 c a ixj 

CV: E b (* J ) < E b (x b ) . 

With a suitable choice of initial states the following set of conditions iaples (ii) f (v) and (vii): 

(a) min aax E (x**) i E (x ) , VCX^.a 1 ) , cV , 

j J 

u J s J 

■ax «in E B (x j ) £ E^xJ . V(X J ,a j ) < cV ; 
s^ 

(b) aax ain E (x*) > ain aax E_(x*) , VZ t C*A , 

u< s’ " u» s 1 " 

ain aax E (x*) < aax ain E fx J ) , VZ ' C*A , 

*« ■ u i *> ■ 


for q*0 f nj*0,j«l,2. In the above C*A arc subsets of CA defined by: 

C*A: E^lx*) 2 E^x 1 ) . 

C'A: E b (x*) - E^ix 1 ) . 

(c) ■ E (x ) - c , V M , ) • li.’ . 

m a j 

Observe that for ft* ■ 0 there is no need for adaptation and that the system (4) crosses the surface q • 0, 

*1 - o time instantenously (vertically) so there is no need for control in view of the saoothness of trajectories. 
Conditions (a), (b) are called control conditions helping to design p J (*) , condition (c) is called adaptive, 
helping to design adaptive laws. Let us check that (a), (b) , (c) indeed imply (ii), (v) , (vii). Consider first 

the case E (x J ) ^ E (x ) . Substituting (c) into (23) in view of (ii) we obtain » negative tens * E (x J ) . 
Boundedness of the work space necessitates the power; E^iV) i0 thus U*)- Substituting (a), (c) , and 

(tl) into (24 ) with (1$. we satisfy (v) in stipulated tiae t c . Note that this holds for any initial states. 

The case E m (x J ) ■ E^Cx^) is trivial as then • JE^x^j ' 0 , * fMx^) * c j - * c j • Finally we check 

(viij. Again first let E^tx*) t E^fx*) and obscrve that 0>) substituted to (2h) implies (vii). The case 

E (x*) * U [x 2 ) is obviously trivial. 

a a 

Observe that, with (10), (c) is implied by the following adaptive laws 

‘‘I * * slgn 'ifrmXi ’^i)' {:> 

for r! / 0 , i r i,...,n . Physically the solutions i** ( V°,t) represent the model energy flux which become 
positive or negative depending upon where is located (below or above the surface iJ * 0) thus regulating 

the increment of J to ;ero from anywhere outside the surface *• * 0 . 

8. Modular Oouble RP-Manipulator 

Our technique is illustrated below on the case study of the four DOE manipul ator with two arms shown in 

El*- *- 



I igurc 4. Hie modular 2'RP manipulator 
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The Lagrange equations of notion for each am result in the following notion equations 

( V***2 q 2 )q l ♦ 2.q 2 qj4 2 ♦ ♦ Kv^cos - .,«r ♦ Xfr ♦ 2 q* - u, (J# 

■ 2 q 2 * *2 q 2^ * k A * *2« ,in q l * u 2 ‘ 

Here \ y X 4 are damping coefficients, A 1# AA 2 spring coefficients, g-gravity acceleration, the remainder 

of notations shown in Fig. 4. The superscripts M J", J ■ 1,2 , are ignored for the tine being. take the 
possible payload on the grippers as unknown but within known bounds which nakes n^ specified by 

n S n 2 S a , 

where n, n positive constants. Allowing sin ■ qj - ^gqj , cos « 1 • IqJ , and subdividing th® equations 
(29) by corresponding inertia coefficients we obtain: 

q*i ♦ r A ♦ H i ■ A Uj , l ■ 1,2 (30 

where , . . . 

, 2 Wi q 2 * W* 1 ! 1 

*1 * ■i r * ♦ * 

P 2 " ‘ q 2 q l * l/ *2 X 4 q 2 ' 

- *l q l - *«V q ? * X 2 q ? • 1 «-2 q 2 q t * »"2 q 2 (31 

l *V J "» "2 q 2 


n 2 * * q l * 5* q l * 


8 l * V r " r ""2 q 2 ' 82 " “2 


The reference model is taken as 


The total energy v>f the model is 


\l * W.1 * '- l q -I * gq -2 * ° • 

q »2 * ^«4 q «2 * ***■! * ° ‘ 


WV * l(q »l‘ q i2 J * ^iSl * 2 *\l%2 


Hj f ferrnt 1 at 1 ng it with respect to time and substituting (32), 


Accordingly , 


E « l VV * * V »4 <2 


1 : (q.q) * (B.u.-i .jq, * (8,u,-: jq, . 


Choose (X J0 .,J°) . C*M J , ) > 1,2 and 2° . C*A . Then the control conditions (a), (b) hold if successively 

•in max| (8ju|-i j)q|| - - v BsJ l t 4 |)1 | ) 1 . J * 1 >*' 

“1 *2 1 (5 

min max( (B^-i J Jq J ) - - f j • 1.2 j 

tl J -J 

a, 
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■ax ■in|(BX-r;)q{J > *1" •“*( ( 8 ? u i' r ?)S?l 
“1*1 U l *S 

■ax min((8'uj-rj)qjl ' «in aax( (8Ju|-r»)q|] 
ul m\ “i "i 


Thus w« choose u* such that for q* f 0 , 


lain »ax[ (8ju1-f! )q|J i 

“1 "1 


ami for such u* , we choose uj satisfying 


■in Bax[ (8?u?*r?)q?l < »ax ainj (8Ju** r p^11 
uj ■{ 1 1 1 1 “1 ■$ 


The procedure for u’ and u* is identical utiliting the second inequalities of (34), (35). Assuming 
symmetry of anss: «| - m{ • ,■«•■>■ « 2 « !■,») , r‘ - r* • r , and substituting the expressions for 


! i * D i ’ B i * *•■) * *» 2 • wc obtain the tracking controllers 


. „” 3 ^y 1 .— (■ 1 r J ♦ «(q*) J ♦ i»qjq 2 * V»|q,|q, , Vqj + 0 


^ suitable constant, Vq^ ■ 0 , 

| - I»! rl * *mpM * * 'jlMjltM ,)' 1 . y q| * " 

l suitable constant, Vq| * 0 ; 


and the collision avoidance controllers 




; m4 mi 


u*(t) » j 


V mUmJ ) 1 ‘ . y M* * " 


suitable constant, Vi’l* * <> 

W4 i: - - - -V 1- ' VM 1 ' 0 * 


- TJ 

u^(t) * *j 

[ suitable constant, Vq| * 0 , 

which imply the control conditions (a), (b) for our example. The adaptive laws (24) are 

Vj 0 , U - 0 

*3 * - tsi * n ‘3 )V »3^1 * Ic ) 

‘J * - tslgn ' iC j 

for j * 1,2 . The first two laws vani:>h identically, since by design 3 ’ . 'l * 'm 2 * <N,un,erica * 

simulation of our -nodular case, with the data m y * 70kg, m - 30kg, m * 40kh. r * O.bom, \* { * 20, * 20, 

V « 5 t a 2 , is shown in fig. 5, and confirms the convergence-avoidance required. 
m3 * a4 


.v# 

**1/ /, 

/ A\ 


figure 3. Numerical simulation 
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